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INTRODUCTION 

The LM628/LM629 are dedicated motion control proces- 
sors. Both devices control DC and brushless DC servo mo- 
tors, as well as, other servomechanisms that provide a 
quadrature incremental feedback signal. Block diagrams of 
typical l_M628/l_M629-based motor control systems are 
shown in Figures 1 and 2. 

As indicated in the figures, the LM628/LM629 are bus pe- 
ripherals; both devices must be programmed by a host proc- 
essor. This application note is intended to present a con- 
crete starting point for programmers of these precision mo- 
tion controllers. It focuses on the development of short pro- 
grams that test overall system functionality and lay the 
groundwork for more complex programs. It also presents a 
method for tuning the loop-compensation PID filter. ' 



REFERENCE SYSTEM 

Figure 18 is a detailed schematic of a closed-loop motor 
control system. All programs presented in this paper were 
developed using this system. For application of the pro- 
grams in other LM628-based systems, changes in basic 
programming structure are not required, but modification of 
filter coefficients and trajectory parameters may be re- 
quired. 

I. PROGRAM MODULES 

Breaking programs for the LM628 into sets of functional 
blocks simplifies the programming process; each block exe- 
cutes a specific task. This section contains examples of the 
principal building blocks (modules) of programs for the 
LM628. 
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FIGURE 1. LM628-Based Motor Control System 
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FIGURE 2. LM629-Based Motor Control System 
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BUSY-BIT CHECK MODULE 

The first module required for successful programming of the 
LM628 is a busy-bit check module. 
The busy-bit, bit zero of the status byte, is set immediately 
after the host writes a command byte, or reads or writes the 
second byte of a data word. See Table I. While the busy-bit 
is set, the LM628 will ignore any commands or attempts to 
transfer data. 

A busy-bit check module that polls the Status Byte and 
waits until the busy-bit is reset will ensure successful 
host/LM628 communications. It must be Inserted after a 
command write, or a read or write of the second byte of 
a data word. Flow diagram 1 represents such a busy-bit 
check module. This module will be used throughout subse- 
quent modules and programs. 

Reading the Status Byte is accomplished by executing a 
RDSTAT command. RDSTAT is directly supported by 
LM628 hardware and is executed by pulling CS, PS, and RD 
logic low. 

Flow Diagram 1. Busy-bit Check Module 
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INITIALIZATION MODULE 

In general, an initialization module contains a reset com- 
mand and other initialization, interrupt control, and data re- 
porting commands. 

The example initialization module, detailed in Figure 3, con- 
tains a hardware reset block and a PORT 12 command. 

Hardware Reset Block 

Immediately following power-up, a hardware reset must be 
executed. Hardware reset is initiated by strobing RST (pin 
27) logic low for a minimum of ei ght LM628 clock peri- 
ods. The reset routine begins after RST is returned to logic 
high. During the reset execution time, 1.5 ms maximum, the 
LM628 will ignore any commands or attempts to transfer 
data. 

A hardware reset forces the LM628 into the state described 
in what follows. 

1. The derivative sampling coefficient, ds, is set to one, and 
all other filter coefficients and filter coefficient input buff- 
ers are set to zero. With ds set to one, the derivative 
sampling interval is set to 2048/fci_K- 



2. All trajectory parameters and trajectory parameters input 
buffers are set to zero. 

3. The current absolute position of the shaft is set to zero 
("home"). 

4. The breakpoint interrupt is masked (disabled), and the 
remaining five interrupts are unmasked (enabled). 

5. The position error threshold is set to its maximum value, 
7FFF hex. 

6. The DAC output port is set for an 8-bit DAC interface. 
Flow diagram 2 illustrates a hardware reset block that in- 
cludes an LM628 functionality test. This test should be com- 
pleted immediately following all hardware resets. 

Flow Diagram 2. Hardware Reset Block 
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Reset Interrupts 

An RSTI command sequence allows the user to reset the 
interrupt flag bits, bits one through six of the status byte. 
See Table I. It contains an RSTI command and one data 
word. 

The RSTI command initiates resetting the interrupt flag bits. 
Command RSTI also resets the host interrupt output pin (pin 
17). 
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FIGURE 3. Initialization 



(with Hardware Reset) 



Note 1: The 8-bit host I/O port is a dual-mode port; it operates in command 
or data mode. The logic level at PS (pin 16) selects the mode. Port c repre- 
sents the LM628 command port-commands are written to the command port 
and the Status Byte is read from the command port. A logic level of "0" at 
PS selects the command port. Port d represents the LM628 data port — data 
is both written to and read from the data port. A logic level of "1" at PS 
selects the data port. 



Note 2: x - don't care 

Note 3: HB - high byte, LB - low byte 

Note 4: All values represented in hex. 

Immediately following the RSTI command, a single data 
word is written. The first byte is not used. Logical zeros in 
bits one through six of the second byte reset the corre- 
sponding interrupts. See Table II. Any combination of the 
interrupt flag bits can be reset within a single RSTI com- 
mand sequence. This feature allows interrupts to be serv- 
iced according to a user-programmed priority. 
In the case of the example module, the second byte of the 
RSTI data word, 00 hex, resets all interrupt flag bits. See 
Figure 3. 

TABLE I. Status Byte Bit Allocation 
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DAC Port Size 

During both hardware and software resets, the DAC output 
port defaults to 8-bit mode. If an LM628 control loop utilizes 
a 12-bit DAC, command PORT12 should be issued immedi- 
ately following the hardware reset block and all subsequent 
resets. Failure to issue command PORT12 will result in er- 
ratic, unpredictable motor behavior. 

If the control loop utilizes an 8-bit DAC, command PORT12 
must not be executed; this too will result in erratic, unpre- 
dictable motor behavior. 

An LM629 will ignore command PORT8 (as it provides an 
8-bit sign/magnitude PWM output). Command PORT12 
should not be issued in LM629-based systems. 
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Software Reset Considerations 

After the initial hardware reset, resets can be accomplished 
with either a hardware reset or command RESET (software 
reset). Software and hardware resets execute the same 
taskst and require the same execution time, 1 .5 ms maxi- 
mum. During software reset execution, the LM628 will ig- 
nore any commands or attempts to transfer data. 
The hardware reset module includes an LM628 functionality 
test. This test is not required after a software reset. 
Figure 4 details an initialization module that uses a software 
reset. 

tin the case of a software reset, the position error threshold remains at its 
pre-reset value. 



Comments 

Figure 5 illustrates, in simplified block diagram form, the 
LM628. The profile generator provides the control loop in- 
put, desired shaft position. The quadrature decoder pro- 
vides the control loop feedback signal, actual shaft position. 
At the first summing junction, actual position is subtracted 
from desired position to generate the control loop error sig- 
nal, position error. This error signal is filtered by the PID filter 
to provide the motor drive signal. 



After executing the example initialization module, the follow- 
ing observations are made. With the integration limit term 
(y and the filter gain coefficients (k p , k,, and k<j) initialized to 
zero, the filter gain is zero. Moreover, after a reset, desired 
shaft position tracks actual shaft position. Under these con- 
ditions, the motor drive signal is zero. The control system 
can not affect shaft position. The shaft should be stationary 
and "free wheeling". If there is significant drive amplifier 
offset, the shaft may rotate slowly, but with minimal torque 
capability. 

Note: Regardless of the free wheeling state of the shaft, the LM628 continu- 
ously tracks shaft absolute position. 

FILTER PROGRAMMING MODULE 

The example filter programming module is shown in Figure 
6. 

Load Filter Parameters (Coefficients) 

An LFIL (Load FILter) command sequence includes com- 
mand LFIL, a filter control word, and a variable number of 
data words. 

The LFIL command initiates loading filter coefficients into 
input buffers. 

The two data bytes, written immediately after LFIL, com- 
prise the filter control word. The first byte programs the de- 
rivative sampling coefficient, d s (i.e. selects the derivative 
sampling interval). The second byte indicates, with logical 
ones in respective bit positions, which of the remaining four 
filter coefficients will be loaded. See Tables III and IV. Any 
combination of the four coefficients can be loaded within a 
single LFIL command sequence. 

Immediately following the filter control word, the filter coeffi- 
cients are written. Each coefficient is written as a pair of 
data bytes, a data word. Because any combination of the 
four coefficients can be loaded within a single LFIL com- 
mand sequence, the number of data words following the 
filter control word can vary in the range from zero to four. 
In the case of the example module, the first byte of the filter 
control word, 00 hex, programs a derivative sampling coeffi- 
cient of one. The second byte, x8 hex, indicates only the 
proportional gain coefficient will be loaded. 
Immediately following the filter control word, the proportion- 
al gain coefficent is written. In this example, k p is set to ten 
with the data word 000A hex. The other three filter coeffi- 
cients remain at zero, their reset value. 

Update Filter 

The update filter command, UDF, transfers new filter coeffi- 
cients from input buffers to working registers. Until UDF is 
executed, the new filter coefficients do not affect the trans- 
fer characteristic of the filter. 
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FIGURE 4. Initialization Module (with Software Reset) 
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FIGURE 5. LM628— Simplified Block Diagram Form 
TABLE III. Filter Control Word Bit Allocation 
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FIGURE 6. Filter Programming Module 
Comments 

After executing both the example initialization and example 
filter programming modules, the following observations are 
made. Filter gain is nonzero, but desired shaft position con- 
tinues to track actual shaft position. Under these conditions, 
the motor drive signal remains at zero. The shaft should be 
stationary and "free wheeling". If there is significant drive 
amplifier offset, the shaft may rotate slowly, but with minimal 
torque capability. 

Initially, k p should be set below twenty, d s should be set to 
one, and kj, k^, and i| should remain at zero. These values 
will not provide optimum system performance, but they will 
be sufficient to test system functionality. See Tuning the PID 
Filter. 

TRAJECTORY PROGRAMMING MODULE 

Figure 7 details the example trajectory programming mod- 
ule. 

Load Trajectory Parameters. 

An LTRJ (Load TRaJectory) command sequence includes 
command LTRJ, a trajectory control word, and a variable 
number of data words. 

The LTRJ command initiates loading trajectory parameters 
into input buffers. 



The two data bytes, written immediately after LTRJ, com- 
prise the trajectory control word. The first byte programs, 
with logical ones in respective bit positions, the trajectory 
mode (velocity or position), velocity mode direction, and 
stopping mode. See Stop Module. The second byte indi- 
cates, with logical ones in respective bit positions, which of 
the three trajectory parameters will be loaded. It also indi- 
cates whether the parameters are absolute or relative. See 
Table V. Any combination of the three parameters can be 
loaded within a single LTRJ command sequence. 
Immediately following the trajectory control word, the trajec- 
tory parameters are written. Each parameter is written as a 
pair of data words (four data bytes). Because any combina- 
tion of the three parameters can be loaded within a single 
LTRJ command sequence, the number of data words fol- 
lowing the trajectory control word can vary in the range from 
zero to six. 

In the case of the example module, the first byte of the 
trajectory control word, 00 hex, programs the LM628 to op- 
erate in position mode. The second byte, OA hex, indicates 
velocity and position will be loaded and both parameters are 
absolute. Four data words, two for each parameter loaded, 
follow the trajectory control word. 

Start Motion Control 

The start motion control command, STT (STarT), transfers 
new trajectory parameters from input buffers to working reg- 
isters and begins execution of the new trajectory. Until STT 
is executed, the new trajectory parameters do not affect 
shaft motion. 

Note: At this point no actual trajectory parameters are loaded. Calculation ot 
trajectory parameters and execution of example moves is left for a 
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FIGURE 7. Trajectory Programming Module 
STOP MODULE 

This module demonstrates the programming flow required 
to stop shaft motion. 

While the LM628 operates in position mode, normal stop- 
ping is always smooth and occurs automatically at the end 
of a specified trajectory (i.e., no stop module is required). 
Under exceptional conditions, however, a stop module can 
be used to affect a premature stop. 

While the LM628 operates in velocity mode, stopping is al- 
ways accomplished via a stop module. 
The example stop module, shown in Figure 8, utilizes an 
LTRJ command sequence and an STT command. 

Load Trajectory Parameters 

Bits eight through ten of the trajectory control word select 
the stopping mode. See Table V. 

In the case of the example module, the first byte of the 
trajectory control word, x1 hex, selects motor-off as the de- 
sired stopping mode. This mode stops shaft motion by set- 
ting the motor drive signal to zero (the appropriate offset-bi- 
nary code to apply zero drive to the motor). 
Setting bit nine of the trajectory control word selects stop 
abruptly as the desired stopping mode. This mode stops 
shaft motion (at maximum deceleration) by setting the target 
position equal to the current position. 



Setting bit ten of the trajectory control word selects stop 
smoothly as the desired stopping mode. This mode stops 
shaft motion by decelerating at the current user-pro- 
grammed acceleration rate. 

Note: Bits eight through ten of the trajectory control word must be used 
exclusively; only one of them should be logic one at any time. 

Start Motion Control 

The start motion control command, STT, must be executed 
to stop shaft motion. 

Comments 

After shaft motion is stopped with either an "abrupt" or a 
"smooth" stop module, the control system will attempt to 
hold the shaft at its current position. If forced away from this 
desired resting position and released, the shaft will move 
back to the desired position. Unless new trajectory parame- 
ters are loaded, execution of another STT command will 
restart the specified move. 

After shaft motion is stopped with a '"motor-off" stop mod- 
ule, desired shaft position tracks actual shaft position. Con- 
sequently, the motor drive signal remains at zero and the 
control system can not affect shaft position; the shaft 
should be stationary and free wheeling. If there is significant 
drive amplifier offset, the shaft may rotate slowly, but with 
minimal torque capability. Unless new trajectory parameters 
are loaded, execution of another STT command will restart 
the specified move. 
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FIGURE 8. Stop Module (Motor-Off) 
II. PROGRAMS 

This section focuses on the development of four brief 
LM628 programs. 

LOOP PHASING PROGRAM 

Following initial power-up, the correct polarity of the motor 
drive signal must be determined. If the polarity is incorrect 
(loop inversion), the drive signal will push the shaft away 
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from its desired position rather than towards it. This results 
in "motor runaway", a condition characterized by the motor 
running continuously at high speed. 

The loop phasing program, detailed in Figure 9, contains 
both the example initialization and filter programming mod- 
ules. It also contains an LTRJ command sequence and an 
STT command. 

Note: Execution of this simple program is only required the first time a new 
system is used. 

Load Trajectory Parameters 

An LTRJ (Load TRaJectory) command sequence includes 
command LTRJ, a trajectory control word, and a variable 
number of data words. 

In the case of the Loop Phasing Program, the first byte of 
the trajectory control word, 00 hex, programs the LM628 to 
operate in position mode. The second byte, 00 hex, indi- 
cates no trajectory parameters will be loaded (i.e. in this 
program, zero data words follow the trajectory control 
word). The three trajectory parameters will remain at zero, 
their reset value. 

Start Motion Control 

The start motion control command, STT (STarT), transfers 
new trajectory parameters from input buffers to working reg- 
isters and begins execution of the new trajectory. Until STT 
is executed, the new trajectory parameters do not affect 
shaft motion. 



Comments 

Execution of command STT results in execution of the de- 
sired trajectory. With the acceleration set at zero, the profile 
generator generates a desired shaft position that is both 
constant and equal to the current absolute position. See 
Figure 5. Under these conditions, the control system will 
attempt to hold the shaft at its current absolute postion. The 
shaft will feel lightly "spring loaded". If forced (CAREFUL- 
LY) away from its desired position and released, the shaft 
will spring back to the desired position. 



If the polarity of the motor drive signal is incorrect (loop 
inversion), motor runaway will occur immediately after exe- 
cution of command STT, or after the shaft is forced (CARE- 
FULLY) from its resting position. 

Loop inversion can be corrected with one of three methods: 
interchanging the shaft position encoder signals (channel A 
and channel B), interchanging the motor power leads, or 
inverting the motor command signal before application to 
the motor drive amplifier. For LM629 based systems, loop 
inversion can be corrected by interchanging the motor pow- 
er leads, interchanging the shaft position encoder signals, 
or logically inverting the PWM sign signal. 

SIMPLE ABSOLUTE POSITION MOVE 

The Simple Absolute Position Move Program, detailed in 
Figure 13, utilizes both the initialization and filter program- 
ming modules, as well as, an LTRJ command sequence and 
an STT command. 

Factors that influenced the development of this program in- 
cluded the following: the program must demonstrate simple 
trajectory parameters calculations, the program must dem- 
onstrate the programming flow required to load and execute 
an absolute position move, and correct completion of the 
move must be verifiable through simple observation. 
Move: The shaft will accelerate at 0.1 rev/sec 2 until it 
reaches a maximum velocity of 0.2 rev/sec, and then decel- 
erate to a stop exactly two revolutions from the starting po- 
sition. See Figure 10. 

Note: Absolute position is position measured relative to zero (home). An 
absolute position move is a move that ends at a specified absolute 
position. For example, independent of the current absolute position of 
the shaft, if an absolute position of 30,000 counts is specified, upon 
completion of the move the absolute position of the shaft will be 
30,000 counts (i.e. 30,000 counts relative to zero). The example pro- 
gram calls for a position move of two revolutions. Because the start- 
ing absolute position is counts, the move is accomplished by speci- 
fying an absolute position of 8000 counts. See Figure 13. 

The Quadrature Incremental Encoder 

As a supplement to the trajectory parameters calculations, a 
brief discussion is provided here to differentiate between 
encoder lines and encoder counts. 

A quadrature incremental shaft encoder encodes shaft rota- 
tion as electrical pulses. Figure 1 1 details the signals gener- 
ated by a 3-channel quadrature incremental encoder. The 
LM628 decodes (or "counts") a quadrature incremental sig- 
nal to determine the absolute position of the shaft. 



Velocity (HPS) 




TL/H/10660-13 

FIGURE 10. Velocity Profile for Simple 
Absolute Position Move Program 



Port Bytes Command Comments 



Initialization Module 

Filter Programming Module 

c 1 F LTRJ This command initiates 
loading the trajectory 
parameters input buffers. 

Busy-bit Check Module 
d 00 HB These two bytes are the 

d 00 LB trajectory control word. A 00 

hex LB indicates no trajectory 
parameters will be loaded. 

Busy-bit Check Module 
c 01 STT STT must be issued to 

execute the desired 
trajectory. 



FIGURE 9. Loop Phasing Program 
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ONE 

■ ENCODER LINE 



TLTLTLTL 



The reference system uses a one thousand line encoder. 



—•J U— INOtX = A'B'IN 

TL/H/10860-14 

FIGURE 11. 3-Channel Quadrature Encoder Signals 

The resolution ol a quadrature incremental encoder is usu- 
ally specified as a number of lines. This number indicates 
the number of cycles of the output signals for each com- 
plete shaft revolution. For example, an N-line encoder gen- 
erates N cycles of its output signals during each complete 
shaft revolution. 

By definition, two signals that are in quadrature are 90° out 
of phase. When considered together, channels A and B 
(Figure 1 1) traverse four distinct digital states during each 
full cycle of either channel. Each state transition represents 
one count of shaft motion. The leading channel indicates 
the direction of shaft rotation. 

Each line, therefore, represents one cycle of the output sig- 
nals, and each cycle represents four encoder counts. 



CYCLES \ 
REVOLUTION J 



COUNTS \ 
CYCLE I " 



REVOLUTION / 



REVOLUTION 



Sample Period 

Sampling of actual shaft positioin occurs at a fixed frequen- 
cy, the reciprocal of which is the system sample period. The 
system sample period is the unit of time upon which shaft 
acceleration and velocity are based. 

T s = (2048) ■: ( — - — ) System Sample Period 
' 'CLOCK » 

The reference system uses an 8 MHz clock. The sample 
period of the reference system follows directly from the defi- 
nition. 

I 1 ^ c SECONDS 

Ts = (2048) x - 256 > 10 -6 

11 \8x 106Hzj SAMPLE 



Trajectory Parameters Calculations 

The shaft will accelerate at 0.1 rev/sec 2 until it reaches a 
maximum velocity of 0.2 rev/sec, and then decelerate to a 
stop exactly two revolutions from the starting position. 
Trajectory parameters calculations for this move are de- 
tailed in Figure 12. 

Comments 

After completing the move, the control system will attempt 
to hold the shaft at its current absolute position. The shaft 
will feel lightly "spring loaded". If forced away from its de- 
sired resting position and released, the shaft will move back 
to the desired position. 



REVOLUTION 



4000 



COUNTS \ 
REVOLUTION/ 



X 256 X 10-6 



^2.62 X 10" 



s COUNTS} x(65;596)= 1 _ 718 



SECONDS \ 2 
SAMPLE / 

COUNTS 



(» 



REVOLUTIONS\ 



SAMPLE 2 / 



SAMPLE 2 



SECOND 2 I 
Acceleration Scaled 



2.62 x 10-5 



COUNTS 
SAMPLE 2 



A = 2 



COUNTS 
SAMPLE 2 



A = 00 00 00 02 hex 



Acceleration Rounded 



COUNTS 



V = 4000 



SAMPLE 2 
COUNTS \ 



REVOLUTION 



\ / SECONDS\ / REVOLUTIONS\ 

X 256 X 10-6 - - < 2 = 2048 

I \ SAMPLE ) \ SECOND / 



COUNTS 
SAMPLE 



V = 



^0.2 



V = 13,422 



COUNTS \ 
' SAMPLE I 

, COUNTS 
SAMPLE 



, COUNTS 
SAMPLE 



Velocity Scaled 



Velocity Rounded 



V = 00 00 34 6E hex 



COUNTS 



P = 4000 - 



SAMPLE 
COUNTS \ 



REVOLUTION/ 
P = 00 00 1 F 40 hex COUNTS 



X (2.0 REVOLUTIONS) = 8000 COUNTS 



FIGURE 12. Calculations of Trajectory Parameters for Simple Absolute Position Move 
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Port 


Bytes 


Command Comments 






Initialization Module 






Filter Programming Module 


c 


1F 


LTRJ This command initiates 






loading the trajectory 






parameters input buffers 






Busy-bit Check Module 


d 


00 


HB These two bytes are the 


d 


2A 


LB trajectory control word. A 2A 






hex LB indicates 






arpplpratinn vplnpitv and 






position will be loaded and all 






three parameters are 






absolute. 






DUSy-DlL LilleCK IVIOUUIcJ 


d 


00 


HB Acceleration is loaded in two 


d 


00 


i q Hata uunrrl^ Thp^p two hvtp^ 






are the high data word. In this 






case, the acceleration is 0.1 






rev/sec 2 . 






Busy-bit Check Module 


d 


00 


HB acceleration data word (low) 


d 


02 


LB 






Busy-bit Check Module 


d 


00 


HB velocity is loaded in two data 


ai 
U 


uu 


wui uo. i mcoc iviu uyico aic 






the high data word. In this 






case, the velocity is 0.2 rev/ 






sec. 






Busy-bit Check Module 


d 


34 


HB velocity data word (low) 


d 


6E 


LB 






Busy-bit Check Module 


d 


00 


HB Position is loaded in two data 


d 


00 


LB words. These two bytes are 






the high data word. In this 






case, the position loaded is 






pinht thru KflnH prii intQ Thic 






results in a move of two 






revolutions in the forward 






direction. 






Busy-bit Check Module 


d 


1F 


HB position data word (low) 


d 


40 


LB 






Busy-bit Check Module 


c 


01 


STT STT must be issued to 






execute the desired 






trajectory. 



FIGURE 13. Simple Absolute Position Move Program 

SIMPLE RELATIVE POSITION MOVE 

This program demonstrates the programming flow required 
to load and execute a relative position move. See Figure 14. 
Move: Independent of the current resting position of the 
shaft, the shaft will complete thirty revolutions in the reverse 
direction. Total time to complete the move is fifteen sec- 
onds. Total time for acceleration and deceleration is five 
seconds. 



Note: Target position is the final requested position. If the shaft is stationary, 
and motion has not been stopped with a "motor-off" stop module, the 
current absolute position of the shaft is the target position. If motion 
has been stopped with a "motor-off" stop module, or a position move 
has begun, the absolute position that corresponds to the endpoint of 
the current trajectory is the target position. Relative position is posi- 
tion measured relative to the current target position of the shaft. A 
relative position move is a move that ends the specified "relative" 
number of counts away from the current target position of the shaft. 
For example, if the current target position of the shaft is 10 counts, 
and a relative position of 30,000 counts is specified, upon completion 
of the move the absolute position of the shaft will be 30,010 counts 
{i.e. 30,000 counts relative to 10 counts). 

Load Trajectory Parameters 

The first byte of the trajectory control word, 00 hex, pro- 
grams position mode operation. The second byte, 2B hex, 
indicates all three trajectory parameters will be loaded. It 
also indicates both acceleration and velocity will be abso- 
lute values while position will be a relative value. 

Trajectory Parameters Calculations 

Independent of the current resting position of the shaft, the 
shaft will complete thirty revolutions in the reverse direction. 
Total time to complete the move is fifteen seconds. Total 
time for acceleration and deceleration is five seconds. 
The reference system utilizes a one thousand line encoder. 
The number of counts for each complete shaft revolution 
and the total counts for this position move are determined. 



CYCLES 



V REVOLUTION 

/ COUNTS \ 

4000 

V REVOLUTION/ 



)-( 



COUNTS A 
' CYCLE I 



COUNTS 
REVOLUTION 



x (30 REVOLUTIONS) = 120,000 COUNTS 



With respect to time, two-thirds of the move is made at max- 
imum velocity and one-third is made at a velocity equal to 
one-half the maximum velocity.! Therefore, total counts 
traveled during acceleration and deceleration periods is 
one-fifth the total counts traveled. See Figure 15. 

120,000 COUNTS t ota | counts traveled during 

| 24,000 COUN I b acce | eration and deceleration 



24,000 COUNTS 



= 12,000 COUNTS SSor^" 9 



The reference system uses an 8 MHz clock. The sample 
period of the reference system is determined. 

. SECONDS 



T s - (2048) > 



V8<106Hz/ 



-256X10-6- 



SAMPLE 



The number of samples during acceleration (and decelera- 
tion) is determined. 

2.5 SECONDS number of samples 

SECONDS 9/bbbAMPLtb during accelerator, 

256X10-6 

SAMPLE 

Using the number of counts traveled during acceleration 
and the number of samples during acceleration, accelera- 
tion is determined. 

distance traveled during 
2 tirne 1 al acceleration a 

: (12,000 COUNTS) 



2s 

' t2 = 



(2) 



0.000252 



, COUNTS 
SAMPLE 2 



(9766 SAMPLES) 2 

Total counts traveled while at maximum velocity is four-fifths 
the total counts traveled. 

(4) X (120,000 COUNTS) 

— 5 ■ = 96,000 COUNTS 

5 

1 Average velocity during acceleration and deceleration periods is one-half 
the maximum velocity. 
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Port 


Bytes 


Command Comments 






Initialization Module 






Filter Programming Module 


c 


1F 


LTRJ This command initiates 






loading the trajectory 






parameters input buffers. 






Busy-bit Check Module 


d 


00 


HB These two bytes are the 


d 


2B 


LB trajectory control word. A 2B 






hex LB indicates all three 






parameters will be loaded 






and both acceleration and 






velocity will be absolute 






values while position will be a 






relative value. 






Busy-bit Check Module 


d 


00 


HB Acceleration is loaded in two 


d 


00 


LB data words. These two bytes 






are the high data word. In this 






case, the acceleration is 1 7 






counts/sample 2 . 






Busy-bit Check Module 


d 


00 


HB acceleration data word (low) 


d 


11 


LB 






Busy-bit Check Module 


d 


00 


HB Velocity is loaded in two data 


d 


02 


LB words. These two bytes are 






the high data word. In this 






case, velocity is 161 ,087 






counts/sample. 






Busy-bit Check Module 


d 


75 


HB velocity data word (low) 


d 


3F 


LB 






Busy-bit Check Module 


d 


FF 


HB Position is loaded in two data 


d 


FE 


LB words. These two bytes are 






the high data word. In this 






case, the position loaded is 






- 1 20,000 counts. This 






results in a move of thirty 






revolutions in the reverse 






direction. 






Busy-bit Check Module 


d 


2B 


HB position data word (low) 


d 


40 


LB 






Dusy-Dix oneoK rvioouie 


c 


01 


STT STT must be issued to 






execute the desired 






trajectory. 




t (sumpl.s) 



TL/H/10860-15 

FIGURE 15. Velocity Profile for Simple 
Relative Position Move Program 

The number of samples while at maximum velocity is deter- 
mined. 

10SECONDS = 39 062 SAMPLES number 01 sam P'^ s w „ hile at 

SECONDS maximum velocity 



Using the total counts traveled while at maximum velocity 
and the number of samples while at maximum velocity, ve- 
locity is determined. 



96,000 COUNTS 



39,062 SAMPLES SAMPLE 

Both acceleration and velocity values are scaled. 

/ COUNTS \ COUNTS 

(° 000252 s7MPLEi) ■^- ,8 - S15 SAmSp 

/ COUNTS \ COUNTS 

2.458 ■ 65.536) = 161,087.488 

\ SAMPLE / SAMPLE 

Acceleration and velocity are rounded to the nearest integer 
and all three trajectory parameters are converted to hexa- 
decimal. 



A = 17 = 00 00 00 11 hex 



COUNTS 



V = 161,087 = 00 02 75 3F hex 



SAMPLE 2 

COUNTS 
SAMPLE 
FF FE 2B 40 hex COUNTS 



BASIC VELOCITY MODE MOVE WITH BREAKPOINTS 

This program demonstrates basic velocity mode program- 
ming and the (typical) programming flow required to set both 
absolute and relative breakpoints. See Figure 17. 
Move: The shaft will accelerate at 1.0 rev/sec 2 until it 
reaches a maximum velocity of 2.0 rev/sec. After complet- 
ing twenty forward direction revolutions (including revolu- 
tions during acceleration), the shaft will accelerate at 1.0 
rev/sec 2 until it reaches a maximum velocity of 4.0 rev/sec. 
After completing twenty forward direction revolutions (in- 
cluding revolutions during acceleration), the shaft will decel- 
erate (at 1.0 rev/sec 2 ) to a stop. See Figure 16. 



FIGURE 14. Simple Relative Position Move Program 
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t (seconds) 



TL/H/10860-16 



FIGURE 16. Velocity Profile for Basic Velocity Mode with Breakpoints Program 



Mask Interrupts 

An MSKI command sequence allows the user to determine 
which interrupt conditions result in host interrupts; interrupt- 
ing the host via the host interrupt output (pin 17). It contains 
an MSKI command and one data word. 
The MSKI command initiates interrupt masking. 
Immediately following the MSKI command, a single data 
word is written. The first byte is not used. Bits one through 
six of the second byte determine the masked/unmasked 
status of each interrupt. See Table H. Any zeros in this 6-bit 
field mask (disable) the corresponding interrupts while any 
ones unmask (enable) the corresponding interrupts. 
In the case of the examlple program, the second byte of the 
MSKI data word, 40 hex, enables the breakpoint interrupt. 
All other interrupts are disabled (masked). 
When interrupted, the host processor can read the Status 
Byte to determine which interrupt condition(s) occurred. See 
Table I. 

Note: Command MSKI controls only the host interrupt process. Bits one 
through six of the Status Byte reflect actual conditions independent of 
the masked/unmasked status of individual interrupts. This feature al- 
lows interrupts to be serviced with a polling scheme. 

Set Breakpoints (Absolute and Relative) 

An SBPA command sequence enables the user to set 
breakpoints in terms of absolute shaft position. An SBPR 
command sequence enables setting breakpoints relative to 
the current target position. When a breakpoint position is 
reached, bit six of the status byte, the breakpoint interrupt 
flag, is set to logic high. If this interrupt is enabled (un- 
masked), the host will be interrupted via the host interrupt 
output (pin 17). 

An SBPA (or SBPR) command initiates loading/setting a 
breakpoint. The two data words, written immediately follow- 
ing the SBPA (or SBPR) command, represent the break- 
point position. 



The example program contains a relative breakpoint set at 
80,000 counts relative to position zero (the current target 
position). This represents a move of twenty forward direc- 
tion revolutions. When this position is reached, the LM628 
interrupts the host processor, and the host executes a se- 
quence of commands that increases the maximum velocity, 
resets the breakpoint interrupt flag, and loads an absolute 
breakpoint. 

The example program contains an absolute breakpoint set 
at 160,000 counts. When this absolute position is reached, 
the LM628 interrupts the host processor, and the host exe- 
cutes a Smooth Stop Module. 

Breakpoint positions for this example program are deter- 
mined. 



COUNTS \ 
REVOLUTION / 

= 80,000 COUNTS 



(20 REVOLUTIONS) 



relative 
breakpoint 



COUNTS \ 



REVOLUTION/ 
= 160,000 COUNTS 



X (40 REVOLUTIONS) 



absolute 
breakpoint 



Load Trajectory Parameters 

This example program contains two LTRJ command se- 
quences. The trajectory control word of the first LTRJ com- 
mand sequence, 1828 hex, programs forward direction ve- 
locity mode, and indicates an absolute acceleration and an 
absolute velocity will be loaded. The trajectory control word 
of the second LTRJ command sequence, 180C hex, pro- 
grams forward direction velocity mode, and indicates a rela- 
tive velocity will be loaded. See Table V. 
Trajectory parameters calculations follow the same format 
as those detailed for the simple absolute position move. 
See Figure 12. 
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Port 


Bytes 


Command Comments 






I 1 II UdllZd UUl l IVIUUUIc 






Filter Programming Module 


c 


1C 


MSKI Mask interrupts. 






Busy-bit Check Module 


d 


XX 


HR dnn't parp 


d 


40 


LB A 40 hex LB enables 






(unmasks) the breakpoint 






interrupt. All other interrupts 






are disabled (masked). 






Busy-bit Check Module 


c 


21 


SPBR This command initiates 






loading a relative breakpoint. 






Ri iQU-hit f.hpnk Mnriiilp 
□uoy ui i wi icur\ iviuuuio 


d 


00 


HR A hrpaknnint InaripH in two 

1 1 Lj r\ Ui pUI 1 r L lo 1 U CtUC\J III IVVU 


M 
U 


U i 


LtJ udid wurub. i ntJbfc; iwu uyieb 






die me riiyri udid wuru. in inib 






case, the breakpoint is 






80,000 counts relative to the 






current commanded target 






position (zero). 






Busy-bit Check Module 


d 


38 


HB breakpoint data word (low) 


d 


80 


LB 






Busy-bit Check Module 


c 


1F 


LTRJ Load trajectory. 






□uoy uii wi ic»-ir\ iviuuuic 


H 


1 8 


nu 1 Mebe IWU uyieb die llle 


a 


no 


Ld iidjeuiury ouiiuui wuru. a\ i o 






hex HB programs forward 






direction velocity mode 






operation. A 28 hex LB 






indicates acceleration and 






velocity will be loaded and 






both values are absolute. 






Ri icw hit Phorl^ r\^r\Hi i 1 o 
□Uoy Ull ul lcL.r\ IvIUUUie 


a 


00 


HB Acceleration is loaded in two 




00 


1 R Hats iwnrH? Thp^p twn hvtpQ 






are the high data word. In this 






case, the acceleration is 1 .0 






rev/sec 2 . 






Busy-bit Check Module 


d 


00 


HB acceleration data word (low) 


d 


11 


LB 






Busy-bit Check Module 


d 


00 


HB Velocity is loaded in two data 


d 


02 


LB words. These two bytes are 






the high data word. In this 






case, velocity is 2.0 rev/s. 






Busy-bit Check Module 


d 


OC 


HB velocity data word (low) 


d 


4A 


LB 






Busy-bit Check Module 



Port 


Bytes 


Command 


Comments 


c 


01 


STT 


Start motion control. 






Busy-bit Check Module 


c 


1F 


LTRJ 


This command initiates 








loading the trajectory 








parameters input buffers. 






Busy-bit Check Module 


d 


18 


HB 


These two bytes are the 


d 


OC 


LB 


trajectory control word. A 18 








hex HB programs forward 








direction velocity mode 








operation. A 0C hex LB 








indicates only velocity will be 








loaded and it will be a relative 








value. 






Busy-bit Check Module 


d 


00 


HB 


Velocity is loaded in two data 


□ 


no 


LB 


words. These two bytes are 








the high data word. In this 








case, velocity is 2.0 rev/ s. 








Because this is a relative 








value, the current velocity will 








be increased by 2.0 rev/s. 








The resultant velocity will be 








4.0 rev/s. 






Busy-bit Check Module 


d 


OC 


HB 


velocity data word (low) 


d 


4A 


LB 








wait 


This wait represents the host 








processor waiting for an 








LM628 breakpoint interrupt. 


c 


01 


STT 


Start motion control. 






Busy-bit Check Module 


c 


1D 


RSTI 


Reset interrupts. 






Busy-bit Check Module 


d 


XX 


HB 


don't care 


d 


00 


LB 


Zeros in bits one through six 








reset all interrupts. 






Busy-bit Check Module 


c 


20 


SPBA 


This command initiates 








loading an absolute 








breakpoint. 






Busy-bit Check Module 


d 


00 


HB 


A breakpoint is loaded in two 


d 


02 


LB 


data words. These two bytes 








are the high data word. In this 








case, the breakpoint is 








160,000 counts absolute. 






Busy-bit Check Module 


d 


71 


HB 


breakpoint data word (low) 


d 


00 


LB 








wait 


This wait represents the host 








processor waiting for an 








LM628 breakpoint interrupt. 






"Smooth" Stop Module 



FIGURE 17. Basic Velocity Mode Move with Breakpoints Program 
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3-Channtl Gear 
Incremental 
Optical Encodir- 
1000 Un.s 



• H.wlatt 
Packard HEPS-6310 

TL/H/10860-4 

•Note: All resistor values in II 

FIGURE 18. Reference System 



III. TUNING THE PID FILTER 
BACKGROUND 

The transient response of a control system reveals impor- 
tant information about the "quality" of control, and because 
a step input is easy to generate and sufficiently drastic, the 
transient response of a control system is often character- 
ized by the response to a step input, the system step re- 
sponse. 

In turn, the step response of a control system can be char- 
acterized by three attributes: maximum overshoot, rise time, 
and settling time. These step response attributes are de- 
fined in what follows and detailed graphically in Figure 19. 

1 . The maximum overshoot, Mp, is the maximum peak val- 
ue of the response curve measured from unity. The 
amount of maximum overshoot directly indicates the rel- 
ative stability of the system. 

2. The rise time, t r , is the time required for the response to 
rise from ten to ninety percent of the final value. 

3. The settling time, t s , is the time required for the response 
to reach and stay within two percent of the final value. 

A critically damped control system provides optimum per- 
formance. The step response of a critically damped control 
system exhibits the minimum possible rise time that main- 
tains zero overshoot and zero ringing (damped oscillations). 
Figure 20 illustrates the step response of a critically damped 
control system. 



-t y->. Allowable tolerance 

?> / X. i . L t» 






f r- y 


• », 





TL/H/10860-17 

FIGURE 19. Unit Step Response Curve Showing 
Transient Response Attributes 



c(0 




I 

TL/H/10860-18 

FIGURE 20. Unit Step Response of a 
Critically Damped System 

INTRODUCTION 

The LM628 is a digital PID controller. The loop-compensa- 
tion filter of a PID controller is usually tuned experimentally, 
especially if the system dynamics are not well known or 
defined. 



The ultimate goal of tuning the PID filter is to critically damp 
the motor control system — provide optimum tracking and 
settling time. 

As shown in Figure 5, the response of the PID filter is the 
sum of three terms, a proportional term, an integral term, 
and a differential term. Five variables shape this response. 
These five variables include the three gain coefficients (k p , 
k,, and k d ), the integration limit coefficient (i|), and the deriv- 
ative sampling coefficient (d s ). Tuning the filter equates to 
determining values for these variable coefficients, values 
that critically damp the control system. 
Filter coefficients are best determined with a two-step ex- 
perimental approach. In the first step, the values of k p , kj, 
and k(j (along with i| and ds) are systematically varied until 
reasonably good response characteristics are obtained. 
Manual and visual methods are used to evaluate the effect 
of each coefficient on system behavior. In the second step, 
an oscilloscope trace of the system step response provides 
detailed information on system damping, and the filter coef- 
ficients, determined in step one, are modified to critically 
damp the system. 

Note: In step one, adjustments to filter coefficient values are inherently 
coarse, while in step two, adjustments are inherently fine. Due to this 
coarse/fine nature, steps one and two complement each other, and 
the two-step approach is presented as the "best" tuning method. 
The PID filter can be tuned with either step one or step two alone. 

STEP ONE— MANUAL VISUAL METHOD 

Introduction 

In the first step, the values of k p , kj, and k^ (along with i| and 
d s ) are systematically varied until reasonably good response 
characteristics are obtained. Manual and visual methods are 
used to evaluate the effect of each coefficient on system 
behavior. 

Note: The next four numbered sections are ordered steps to tuning the PID 
filter. 

1. Prepare the System 

The initialization section of the filter tuning program is exe- 
cuted to prepare the system for filter tuning. See Figure 22. 
This section initializes the system, presets the filter parame- 
ters (kp, k|, il = 0, kj = 2, d s = 1), and commands the 
control loop to hold the shaft at the current position. 
After executing the initialization section of the filter tuning 
program, both desired and actual shaft positions equal zero; 
the shaft should be stationary. Any displacement of the 
shaft constitutes a position error, but with both k p and k, set 
to zero, the control loop can not correct this error. 

2. Determine the Derivative Gain Coefficient 

The filter differential term provides damping to eliminate os- 
cillation and minimize overshoot and ringing, stabilize the 
system. Damping is provided as a force proportional to the 
rate of change of position error, and the constant of propor- 
tionality is krj x d s . See Figure 21. 

Coefficients k^ and d s are determined with an iterative pro- 
cess. Coefficient kj is systematically increased until the 
shaft begins high frequency oscillations. Coefficient d s is 
then increased by one. The entire process is repeated until 
d s reaches a value appropriate for the system. 
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The system sample period sets the time interval between 
updates of position error. The derivative sampling interval is 
an integer multiple of the system sample period. See Table 
IV. It sets the time interval between successive position 
error samples used in the differential term, and, therefore, 
directly affects system damping. The derivative sampling in- 
terval should be five to ten times smaller than the system 
mechanical time constant — this means many systems will 
require low d s . In general, however, k,j and d s should be set 
to give the largest k d x d s product that maintains accept- 
ably low motor vibrations. 

Note: Starting kd at two and doubling it is a good method of increasing kj. 
Manually turning the shaft reveals that with each increase of k d , the 
resistance of the shaft to turning increases. The shaft feels increas- 
ingly sluggish and, because k d provides a force proportional to the 
rate of change of position error, the faster the shaft is turned the more 
sluggish it feels. For the reference system, the final values of kj and 
d s are 4000 and 4 respectively. 

Proportional Term 

i i output 



TL/H/10860-19 



Integral Term 

i i output 
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Differential Term 

, • output 
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FIGURE 21. Proportional, Integral, and 
Differential (PID) Force Components 



Port 


Bytes 


Command 


Comments 


c 


00 


RESET 


See Initialization Module Text 






wait 


The maximum time to 








complete RESET tasks is 1.5 








ms. 


c 


06 


PORT12 


The RESET default size of 








the DAC port is eight bits. 








This command initializes the 








DAC port for a 12-bit DAC. It 








should not be issued in 








systems with an 8-bit DAC. 






Busy-bit Check Module 


c 


1D 


RSTI 


This command resets only 








the interrupts indicated by 








zeros in bits one through six 








of the next data word. It also 








resets bit fifteen of the 








Signals Register and the host 








interrupt pin (pin 17). 






Busy-bit Check Module 


H 
u 


XX 


HB 


don't care 


d 


UU 


LB 


Zeros in bits one"through six 








indicate all interrupts will be 








reset. 






Busy-bit Check Module 


c 


1C 


MSKI 


This command masks the 








interrupts indicated by zeros 








in bits one through six of the 








next data word. 






Busy-bit Check Module 


d 


XX 


HB 


don't care 


d 


04 


LB 


A 04 hex LB enables 








(unmasks) the trajectory 








complete interrupt. All other 








interrupts are disabled 








(masked). See Table II. 






Busy-bit Check Module 


c 


1 E 


LFIL 


This command initiates 








loading the filter coefficients 








input buffers. 






Busy-bit Check Module 


d 


00 


HB 


These two bytes are the filter 


d 


x2 


LB 


control word. A 00 hex HB 








sets the derivative sampling 








interval to 2048/f C |_K by 








setting d s to one. A x2 hex LB 








indicates only k d will be 








loaded. The other filter 








parameters will remain at 








zero, their reset default value. 






Busy-bit Check Module 



FIGURE 22. Initialization Section — 
Filter Tuning Program 

(Continued on Next Page) 
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Port 


Bytes 


Command Comments 


d 


00 


HB These two bytes set k d to 


d 


02 


LB two. 






Busy-bit Check Module 


c 


04 


UDF This command transfers new 






filter coefficients from input 






buffers to working registers. 






Until UDF is executed, 






coefficients loaded via the 






LFIL command do not affect 






the filter transfer 






characteristic. 






Busy-bit Check Module 


c 


1F 


LTRJ This command initiates 






loading the trajectory 






parameters input buffers. 






Busy-bit Check Module 


d 


00 


HB These two bytes are the 


d 


00 


LB trajectory control word. A 00 






hex LB indicates no trajectory 






parameters will be loaded. 






Busy-bit Check Module 


c 


01 


STT STT must be issued to 






execute the desired 






trajectory. 



FIGURE 22. Initialization Section- 
Filter Tuning Program (Continued) 

3. Determine the Proportional Gain Coefficient 

Inertial loading causes following (or tracking) error, position 
error associated with a moving shaft. External disturbances 
and torque loading cause displacement error, position error 
associated with a stationary shaft. The filter proportional 
term provides a restoring force to minimize these position 
errors. The restoring force is proportional to the position 
error and increases linearly as the position error increases. 
See Figure 21. The proportional gain coefficient, k p , is the 
constant of proportionality. 

Coefficient k p is determined with an iterative process — the 
value of k p is increased, and the system damping is evaluat- 
ed. This is repeated until the system is critically damped. 
System damping is evaluated manually. Manually turning 
the shaft reveals each increase of k p increases the shaft 
"stiffness". The shaft feels spring loaded, and if forced 
away from its desired holding position and released, the 
shaft "springs" back. If k p is too low, the system is over 
damped, and the shaft recovers too slowly. If k p is too large, 
the system is under damped, and the shaft recovers too 
quickly. This causes overshoot, ringing, and possibly oscilla- 
tion. The proportional gain coefficient, k p , is increased to the 
largest value that does not cause excessive overshoot or 
ringing. At this point the system is critically damped, and 
therefore provides optimum tracking and settling time. 
Note: Starting k p at two and doubling it at each iteration is a good method 
of increasing k p . The final value of k p for the reference system is 40. 

4. Determine the Integral Gain Coefficient 

The filter proportional term minimizes the errors due to iner- 
tial and torque loading. The integral term, however, provides 
a corrective force that can eliminate following error while 
the shaft is spinning and the deflection effects of a static 
torque load while the shaft is stationary. This corrective 
force is proportional to the position error and increases lin- 
early with time. See Figure 21. The integral gain coefficient, 
kj, is the constant of proportionality. 



High values of kj provide quick torque compensation, but 
increase overshoot and ringing. In general, kj should be set 
to the smallest value that provides the appropriate compro- 
mise between three system characteristics: overshoot, set- 
tling time, and time to cancel the effects of a static torque 
load. In systems without significant static torque loading, a kj 
of zero may be appropriate. 

The corrective force provided by the integral term increases 
linearly with time. The integration limit coefficient, i|, acts as 
a clamping value on this force to prevent integral wind-up, a 
backlash effect. In many systems i| can be set to its maxi- 
mum value, 7FFF hex, without any adverse effects. The in- 
tegral term has no effect if ii is set to zero. 
For the test system, the final values of kj and i| are 5 and 
1000 respectively. 

STEP TWO— STEP RESPONSE METHOD 
Introduction 

The step response of a control system reveals important 
information about the "quality" of control — specifically, de- 
tailed information on system damping. 
In the second step to tuning the PID filter, an oscilloscope 
trace of the control system step response is used to accu- 
rately evaluate system damping, and the filter coefficients, 
determined in step one, are fine tuned to critically damp the 
system. 

Software Considerations 

The step generation section of the filter tuning program pro- 
vides the control loop with a repetitive small-signal step in- 
put. This is accomplished by repeatedly executing a small 
position move with high maximum velocity and high acceler- 
ation. See Flow Diagram 3 and Figure 23. 

GOD 



Load Trajectory 
Parameters. 

► 



Start the step. 



Read the Status Byte. 




Reset interrupts. 



Wait. 



TL/H/10860-22 

Flow Diagram 3. Step Generation 
Section of Filter Tuning Program 



17 



Port 


Bytes 


Command Comments 


c 


1F 


LTRJ This command initiates 






loading the trajectory 






parameters input buffers. 






Duby-uu o[ifc?ui\ iviuuuie 


a 


nn 


fiD i nese two Dyies are ine 


a 


2B 


LB trajectory control word. A 2B 






hex LB indicates 






acceleration, velocity, and 






position will be loaded and 






both acceleration and 






velocity are absolute while 






position is relative. 






Busy-bit Check Module 


d 


00 


HB Acceleration is loaded in two 


d 


04 


LB data words. These two bytes 






are the high data word. 






Busy-bit Check Module 


d 


A3 


HB acceleration data word (low) 






Busy-bit Check Module 


d 


00 


HB Velocity is loaded in two data 


d 


07 


LB words. These two bytes are 






the high data word. 






Busy-bit Check Module 


d 


A1 


HB velocity data word (low) 


d 


20 


LB 






Busy-bit Check Module 


d 


00 


HB Position is loaded in two data 


d 


00 


LB words. These two bytes are 






the high data word. 






Busy-bit Check Module 


d 


00 


HB position data word (low) 


d 


C8 


LB 
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Bytes 
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Comments 






Busy-bit Check Module 


c 


01 


STT 


STT must be issued to 








execute the desired 








trajectory. 






Busy-bit Check Module 


c 


XX 


RDSTAT 


Thic rnmmflnri rparlc. thp 
I Mia i_ui 1 1 1 1 ia\ iu I calls Lilt; 








Qtati ic Rwto It ic Hiror^tlw 
OldlUb DyifcJ. II lb UlltSClly 








bUppUl IcU Uy LlVfOtU 








harfiwarp anH pan hp 

I lal UVVal C al IU Lai I UC 








executed at any time by 








nnllinnCS PS and RD Innir 

[juiiihm wo , r o , di iu ni_/ luuiis 








\r\\xj Qtati ic information 
iuw. oicaiub in i ui 1 1 id uui i 








rpmainc \/aliH ac lonn ac RPl ic 
lUllldlilb vdliu db lUliy da nu lb 








logic low. 






decision 


If the Trajectory Complete 








interrupt bit is set, continue. 








Otherwise loop back to 








PnCTAT 


c 


1 Hi 
l U 


no I I 


This command resets only 








the interrupts indicated by 








zeros in bits one through six 








of the next data word. It also 








resets bit fifteen of the 








Signals Register and the host 








interrupt pin (pin 17). 


d 


XX 


HB 


don't care 


d 


00 


LB 


Zeros in bits one through six 








indicate all interrupts will be 








reset. 






wait 


This wait block inserts a delay 








between repetitions of the 








step input. The delay is 








application specific, but a 








good range of values for the 








deiay is 5 ms to 5000 ms. 






LOOP 


Loop back to STT. 



FIGURE 23. Step Generation Section— Filter Tuning Program 
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Hardware Considerations 

For a motor control system, an oscilloscope trace of the 
system step response is a graph of the real position of the 
shaft versus time after a small and instantaneous change in 
desired position. 

For an LM628-based system, no extra hardware is needed 
to view the system step response. During a step, the volt- 
age across the motor represents the system step response, 
and an oscilloscope is used to generate a graph of this re- 
sponse (voltage). 

For an l_M629-based system, extra hardware is needed to 
view the system step response. Figure 24 illustrates a circuit 
for this purpose. During a step, the voltage output of this 
circuit represents the system step response, and an oscillo- 
scope is used to generate a graph of this response. 
The oscilloscope trigger signal, a rectangular pulse train, is 
taken from the host interrupt output pin (pin 17) of the 
LM628/LM629. This signal is generated by the combination 
of a trajectory complete interrupt and a reset interrupts 
(RSTI) command. See Flow Diagram 3. 

Note: The circuit ot Figure 24 can be used to view the step response of an 
LM628-based system. 

Observations 

What follows are example oscilloscope traces of the step 

response of the reference system. 

Note 1: All traces were generated using the circuit of Figure 24. 



Note 2: All traces were generated using the following "step" trajectory pa- 
rameters: relative position, 200 counts; absolute velocity, 500,000 
counts/ sample; acceleration, 300,000 counts/sample/sample. 
These values generated a good small-signal step input for the ref- 
erence system; other systems will require different trajectory pa- 
rameters. In general, step trajectory parameters consist of a small 
relative position, a high velocity, and a high acceleration. 
The position parameter must be relative. Otherwise, a define home 
command (DFH) must be added to the main loop of the step gener- 
ation section — filter tuning program. See Flow Diagram 3. 
The circuit for viewing the system step response uses an 8-bit ana- 
log-to-digital converter. See Figure 24. To prevent converter over- 
flow, the step position parameter must not be set higher than 200 
counts. 

Note 3: The circuit of Figure 24 produces an "inverted" step response 
graph. The oscilloscope input was inverted to produce a positive- 
going (more familiar) step response graph. 

Figure 25 represents the step response of an under damped 
control system; this response exhibits excessive overshoot 
and long settling time. The filter parameters used to gener- 
ate this response were as follows: k p , 35; kj, 5; k,j, 600; d s , 
4; i|. 1000. Figure 25 indicates the need to increase kj, the 
differential gain coefficient. 

Figure 26 represents the step response of an over damped 
control system; this response exhibits excessive rise time 
which indicates a sluggish system. The filter parameters 
used to generate this response were as follows: k p , 35; kj, 5; 
k d , 10,000; d s , 7; i|, 1000. Figure 26 indicates the need to 
decrease kj and d s . 

Figure 27 represents the step response of a critically 
damped control system; this response exhibits virtually zero 
overshoot and short rise time. The filter parameters used to 
generate this response were as follows: k p , 40; kj, 5; kd, 
4000; d s , 4; i h 1000. 
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FIGURE 24. Circuit for Viewing the System Step Response with an Oscilloscope 
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FIGURE 25. The Step Response of an Under Damped Control System 
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FIGURE 26. The Step Response of an Over Damped Control System 
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FIGURE 27. The Step Response of a Critically Damped Control System 
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SEMICONDUCTOR CORPORATION. As used herein: 

1. Life support devices or systems are devices or 2. A critical component is any component of a life 



systems which, (a) are intended for surgical implant 
into the body, or (b) support or sustain life, and whose 
failure to perform, when properly used in accordance 
with instructions for use provided in the labeling, can 
be reasonably expected to result in a significant injury 
to the user. 



support device or system whose failure to perform can 
be reasonably expected to cause the failure of the life 
support device or system, or to affect its safety or 
effectiveness. 
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